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INTRODUCTION 


The  purpose  of  this  work  is  to  provide  a tutorial  discussion  of 
the  important  computational  problems  associated  with  modern  fire  control 
systems.  A variety  of  such  systems  has  been  proposed,  all  of  which 
employ  estimators  and  digital  computers  in  one  form  or  another. 

Although  there  is  some  consistency  in  the  objectives  of  the  proposed 
systems,  there  is  considerable  variety  in  the  approach  used  in  imple- 
menting them.  This  discussion  will  consider  the  various  approaches 
to  develop  estimators  for  fire  control  systems. 

In  the  course  of  developing  this  report,  a fire  control  simulation 
facility  is  established  ard  tested.  This  simulation  facility  is  a 
highly  structured  set  of  estimation  algorithms  and  their  supporting 
software  together  with  very  high  level  language  and  data  editing 
features.  It  is  possible  using  such  a software  package  to  evaluate 
fire  control  systems  for  the  many  proposed  configurations. 

In  the  process  of  examining  the  important  features  of  modern  fire 
control  systems,  a new  approach  to  the  target  state  estimation  problem 
has  been  developed.  In  a single  state  transition  model,  the  target 
positions  are  represented  in  spherical  coordinates,  and  the  velocities 
and  accelerations  are  represented  in  Cartesian  coordinates. 

The  advantages  of  such  an  approach  arise  in  computational  consid- 
erations. Unnecessary  coordinate  transformations  are  eliminated,  and 
the  approximations  due  to  linearization  of  the  target  and  observation 
models  are  kept  to  a minimum. 
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Models 

Modern  fire  control  systems  which  employ  "optimal"  estimators 
of  the  target  state  require  hypothetical  mathematical  models  as  an 
internal  representation  of  the  target  behavior.  The  models  include 
an  observation  model  and  a target  dynamics  model.  The  observation 
model  states  the  relationship  between  the  actual  target  state  and  the 
observed  state.  The  observation  model  usually  acknowledges  the  existence 
of  sensor  errors.  The  magnitudes  of  sensor  errors  depend  directly  upon 
the  accuracy  with  which  the  sensor  is  pointed  at  the  target,  i.e.  The 
target  must  be  kept  within  the  field  of  view  of  the  sensor  . The  problem 
of  pointing  the  sensor  is  a classical  regulator  problem  whose  solution 
will  require  a model  of  the  sensor.  These  three  models  of  the  target, 
observations,  and  sensor  will  be  developed  in  the  sections  which  follow  . 

1 . 1 Target  Model 

In  the  Kalman  style  of  target  state  estimators,  it  is  always 
important  to  hypothesize  a model  for  the  motion  of  the  target.  Ideally, 
this  model  should  be  based  upon  Newtonian  mechanics  and  reflect  the 
actual  behavior  of  the  target.  In  fact,  there  is  not  enough  information 
about  targets  to  substantiate  a Newtonian  model . As  a result  the 
accelerations  are  usually  modeled  as  a random  process.  The  resulting 
model  of  target  dynamics  is: 


(a)  Position  dynamics 


1.1 


(b)  Velocity  dynamics 


1.2 


(c)  Correlated  random  accelerations 


1.3 
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where  U is  assumed  to  be  a noise  process.  The  combined  states  of 
position,  velocity,  and  acceleration  may  be  included  in  a new  state 
vector,  X. 


X = 


which  leads  to  a form 

X = A X + B U 


1.4 


1.5 


where  A and  are  functions  of  a and  b.. 

Assuming  that  is  constant  over  a small  time  interval.  At, 
Equations  1.5  may  be  integrated  over  A t.  The  result  is  a discrete 
model . 


- k+X 


bh 


1.6 


where  the  parameter,  k,  is  the  total  number  of  time  steps  A t,  to  have 
passed.  The  matrices,  0^,  and  B^,  are  functions  of  A t,  and  b. 

Target  models  of  the  form  of  Equation  1.6  predominate  in  the 
design  of  target  state  estimators.  In  such  applications  the  noise,  U^_, 
is  usually  assumed  to  be  "white"  in  the  sense  that  it  is  uncorrelated 
with  noise  which  occurred  at  any  other  time. 

1.2  Observation  Model 


The  observations  of  target  motion  are  usually  incomplete  in  the 
same  sense  that  only  position  and  perhaps  a few  rates  are  observed. 

The  observations  are  modeled  as  a linear  combination  (usually  a linear 
selection)  of  the  target  state  components  which  are  corrupted  by  a 
measurement  error,  V^,. 


4 


1.7 


4 - 44  * 4 

The  vector,  Y^,  is  the  perceived  target  motion. 

Most  of  the  current  generation  of  fire  control  systems  employ  a 
target  model  of  the  form  of  Equations  1.6  and  an  observation  model  of 
the  form  of  Equations  1.7.  The  observation  errors,  V^,  are  also  model- 
led as  white  noise  which  are  further  uncorrelated  with  the  target  noise, 

“k* 

1.3  Models  of  Noise 

Given  a target  model  of  the  form  developed  in  the  previous  section, 
the  question  arises  as  to  how  to  use  the  model  to  design  an  estimation 
algorithm  which  will  both  < stimate  and  predict  the  state  of  the  target. 
The  latest  generation  of  target  state  estimators  utilize  "optimal" 
estimates  and  an  algorithm  due  to  Kalman.  This  algorithm  requires 
adoption  of  a statistical  model  of  the  noise  vectors,  i.e. 


E 

cuk>  = 

E (Vk)  = 0 

1.8 

E 

®aT) 

= Sk 

1.9 

E 

<44t) 

II 

1.10 

E 

<44t) 

= 0 

1.11 

as  well  as  the  assumptions  of  whiteness,  i.e. 

E 

= 0 for  j ^ k 

1.12 

E 

= £ for  j t k 

1.13 

The  matrices,  and  R^,  are  important  parameters  in  the  estimation 
algorithms  to  be  considered.  Usually  can  be  fixed  by  knowledge  of 
sensor  accuracy.  The  choice  of  is  much  more  subtle  since  the  actual 
target  has  no  such  parameter  associated  with  it.  The  parameters,  ot 
(Equation  1.3)  and  Q,  must  be  chosen  in  such  a way  that  the  performance 
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of  the  estimators  is  optimized.  This  usually  requires  consideration 
of  the  magnitude  of  prediction  errors  which  are  the  ultimate  performance 
measures  for  a fire  control  system. 

1.4  Sensor  Model  and  Optimal  Tracking 

In  order  to  compute  the  estimates  suggested  in  the  previous  section, 
a sensor  must  be  available  to  provide  the  inputs,  Y_.  This  sensor  must 
be  pointed  at  the  target  to  whatever  accuracy  is  required  to  keep  the 
target  within  the  "field  of  view"  of  the  sensor.  A control  problem 
emerges  at  this  point  in  order  to  determine  what  the  commands  to  the 
sensor  should  be  to  keep  it  pointing  at  the  target.  The  control  action 
may  be  determined  from  the  models: 


(a)  Target  Model 


4.,  = 4 4 * 4 4 


(b)  Sensor  Model 


1.14 


1.15 


and  a performance  criterion 


N-l 


4 A4*J,0  1*4  4*4  *44  4> 


where 


1.16 


£.  = Weighting  matrices 

AX.  = X.  - X? 

—x  —l  -l 

i£.  Control  Influence  Matrix 
W^,  Command  to  the  sensor 

S 

Assuming  for  convenience  that  4^  = 4^,  the  models  may  be  combined  into 

*4  *i  *4  - 4 Sc  ♦ 4 4 i.i7 


The  stochastic,  optimal  control  problem  of  Equations  1.16  and  1.17  is 
known  to  have  a solution  of  the  form. 
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A 


1.18 


4'444 

A 

where  A is  the  best  linear  unbiased  estimate  of  AX  obtained  by  ignor- 
ing the  control  term,  Wj_. 

The  control  gain,  G^,  is  obtained  from 

6*  • <4  ♦ £ Em  £„>  '^4.1  4 l-« 


where  the  matrix,  £^+j>  comes  from  a reverse  recursion 

4 - & 'Em’1*  \ * 4 

= 


and  4* 

state  may  be  found  from  setting  * £^+i 
Equation  1.21  for  I>  . 


With  fixed  values  of  T^, 


a fixed  value  of  G^_  at  steady 
in  equation  1.20  and  solving 


The  optimal  control  problem  of  Equations  1.16  and  1.17  arises  again 
in  the  gun  pointing  problem.  In  this  case  miss  distances  may  be  fed 
back  through  an  optimal  gain  to  produce  a command  to  the  gun. 


2.  LINEARIZATION 


In  all  of  the  discussions  in  the  previous  sections,  it  was  impli- 
citly assumed  that  every  term  of  any  equation  was  expressed  in  the 
same  coordinate  system.  The  question  immediately  arises  concerning 
what  that  coordinate  system  should  be  and  whether  it  should  be  a moving 
coordinate  system.  The  answer  to  the  question  derives  from  a compro- 
mise between  two  conflicting  issues: 

1.  Computational  convenience 

2.  Ease  of  representation  of  the  noise  vectors. 

In  the  latter  issue,  one  is  faced  with  the  reality  that  target  input 
noise  is  most  conveniently  represented  in  a coordinate  system  closely 
tied  to  the  target.  On  the  other  hand,  measurement  noise  is  most 
conveniently  represented  in  a coordinate  system  which  is  tied  to  a 
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sensor.  In  one  case  Cartesian  coordinates  are  called  for,  and  in  the 
other  case  spherical  polar  coordinates  are  called  for.  These  issues  are 
further  complicated  by  the  fact  that  the  equations  of  motion  are  written 
with  respect  to  an  inertial  coordinate  system  which  may  not  be  one  of 
the  target  or  sensor  coordinate  system. 


2.1  MOVING  COORDINATE  FRAMES 


The  purpose  of  this  section  is  to  clarify  the  relationship  between 
the  various  possible  coordinate  systems  which  one  might  employ  and  to 
propose  a convenient  coordinate  frame.  Consider  first,  the  inertia 
coordinate  system  E,  and  the  moving  coordinate  system,  LOS  (line  of 
sight) . 
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At  any  instant,  any  vector  in  one  of  these  systems  can  be  represented 
in  the  other  system  through  transformation,  Tgg. 


*E 

= T 
— 6E 

^LOS 

position 

2.1 

^E 

= T 
-SE 

^LOS 

velocity 

2.2 

h 

= T 
-SE 

^LOS 

acceleration 

2.3 

T 

-SE 


COS0  cosy 
sin6 

cos9  sinY 


-sin0  cosy 
cos© 

-sin0  sinV 


-sinY 

0 

cosy 


2.4 


The  equations  of  motion  provide  the  relationships  between  these  vectors. 


^E  = ^E 


2.5 


^E  = ^E 

a £ = -ai£  + ^ 

From  the  transformations,  the  derivatives  may  also  be  written 


2.6 

2.7 


Y = T X + T X 
-E  -6EAL0S  -^E  ^LOS 


^E  = ^SE^LOS  + ^6E  ^LOS 


h = ^SE^LOS  + ^SE  ^LOS 


2.8 

2.9 

2.10 


Combining  these  with  the  equations  of  motion,  one  obtains  the  equations 
of  motion  in  a moving  coordinate  system. 


X._  = ^ ♦ vT 


— LOS 


—LOS  -LOS 


2.11 
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2.12 


where 


^LOS 


"9.  XlOS  + ^LOS 


^LOS 


CQ.  ♦ ai) 


^LOS 


+ ^LOS 


a 


T 

-se 


-se 


0 

• 

0 

Ycose 


-e 

0 

Ysin0 


^cosO 

Tsin0 

0 


2.13 


2.14 


The  equations  of  motion  as  in  Equations  2.11,  2.12,  and  2.13  are 
complete  and  in  every  way  state  the  same  behavior  as  in  Equations 
2.5,  2.6,  and  2.7.  In  the  moving  coordinate  system,  LOS,  the  x axis 
always  remains  aligned  with  the  target.  This  is  the  approximate 
alignment  of  the  sensor,  thus  one  might  find  it  convenient  to  express 
measurement  noise  in  such  a coordinate  system.  In  particular,  the 
velocity  in  the  LOS  system  can  be  converted  to  spherical  polar  coordi- 
nates by 


v 

— r 


= - ^LOS 


2.15 


2.16 


M = 


1/r 


rcos© 


2.17 


10 


In  the  equations  of  motion.  Equation  2.15  may  be  used  in  place 
of  Equation  2.11  to  provide  a position  in  spherical  polar  coordinates. 


2.18 


2.19 


2.20 


and  the  observations  may  be  expressed  as 


Y * H X + V 


2.21 


where  Visa  measurement  noise  expressed  in  spherical  polar  coordinates . 
Equations  2.18,  2.19,  and  2.20  are  once  again  complete  equations  of 
motion  in  that  they  express  the  same  target  behavior  as  Equations 
2.5,  2.6  and  2.7.  These  new  equations  are  nonlinear,  and  must  be 
subjected  to  linearization  prior  to  use  as  a basis  for  design  of  a 


Kalman  estimator.  The  matrices,  M and  2.  » are  the  sources  of  the 
nonlinearity  since  they  are  functions  of  the  components  of  X^. 

Use  of  the  latest  estimates  of  0 and  T provides  one  possible 


In  the  case  of  Qj.  an  alternate  approach  is  often  taken  which  is 
known  as  "stepping  coordinates."  In  such  an  approach  it  is  assumed 
that  T,.  is  constant  over  a small  time  period  At  » i.e.  from  the  kth 


★ 


★ 


linearization  for  M,  2 


M (r,  6)  “ M (r,  6) 


2.22 


2 (0.Y)  “ 2 CQ.'n 


2.23 


2.2  STEPPING  COORDINATES 


to  the  k+ll  observation 
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2.24 


(£*  * 0 


2.25 


which  leads  to  equations  of  motion  in  stepping  coordinates. 


2.26 


^LOS  " ^LOS 


2.27 


2.28 


time  t,  they  will  not  be  at  time  t+  At  because  the  coordinate  system 
has  moved.  Once  the  vectors  are  obtained  at  t+A  t,  the  coordinate  system 
is  "stepped"  to  its  new  position  and  the  vectors  expressed  in  this  new 
coordinate  system.  The  size  of  the  step  is  determined  by  X^.  The 
change  of  the  coordinate  transformation,  _T0_,  may  be  expressed  as  a 

be 

Taylor's  series  in  its  previous  value 


This  transformation  will  convert  the  velocities  and  accelerations  to  the 
new  coordinate  system  after  time,  At. 


2.29 


Using  only  the  first  two  terms  as  an  approximation. 


I - 9A  t 


2.30 


^LOS 


k+1 


2.32 
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where  the  superscripts  refer  to  the  particular  instance  of  an  LOS 
coordinate  system.  Further  approximations  on  Equations  2.30  lead  to 


f'r  ^ 1\  rp 

''ifiE  J -ifiE- 


1 

A 

-A0 

A A 

AYcosO 


A0 

1 

A A 

ATsinO 


ATcos© 

/S  A 

ATsin0 

1 


2.33 


Thus  Equations  2.26,  2.27,  2.28,  2.31,  2.32  and  2.33  are  linearized 
equations  of  motion  expressed  in  stepping  coordinates. 

The  target  noise  vector,  U^0g,  in  Equation  2.28  remains  in  a 
somewhat  inconvenient  coordinate  system.  It  is  most  conveniently 
expressed  in  a coordinate  system  aligned  with  the  velocity  vector  of  the 
target.  Such  a noise  vector,  U^.,  may  be  transformed  to  the  LOS  system 
by 


T 

U = T T U 
-LOS  — SE  -TE  -T 


2.34 


where  T^g  depends  upon  the  angular  orientation  of  the  velocity  vector 
of  the  target.  The  transformation,  T^g,  is  derived  from  the  velocity 
vector,  vL0S,  by 


1) 


v = T v 
-E  — 6E  —LOS 


2)0=  tan 
J v 


-1 


<Ve 


2.35 

2.36 


3)  T 


tan 


„ ,2  , .2,1/2 

((vx>E  * <vz)E) 


tyE 

(Ve 


2.37 


3)  XpE  is  the  same  as  Tgp (equation  2.4)  with  0, 

and  T replaced  by  0 and  y respectively 

2.3  a Linearized  Target  and  Observation  Model 

The  derivations  given  in  the  previous  section  lead  to  a linearized 

target  model  with  the  observation  error  represented  in  spherical  polar 
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coordinates  and  with  the  target  noise  expressed  in  a target  velocity 
oriented  Cartesian  frame.  The  resulting  model  may  be  summarized  as 


I.  Target  Model 
(a)  Position 


*r  - M (r,0)  v^;  X, 


r 1 

0 
T 


(b)  Velocity 


v^Los  = £lqS  (Cartesian  Coordinates) 


(c)  Acceleration 


ilOS  = -c^LOS  + ^LOS  (Artesian  Coordinates 


II.  Observation  Model 


Y = H X + V (Spherical  Polar  Coordinates) 

— r — — 'T'  — T*  * 


III.  Target  Noise 


U = T T u • it  = 
--LOS  SE  TE  -T*  T 


where:  is  along  the  velocity  vector  of  the  target. 

Uz  is  in  the  horizontal  plane. 

UY  completes  the  orthogonal  set  of  components. 

IV.  Stepping  Coordinates 


k+1  k 

(Ice  ) Geo)  = Transformation  from  the  LOS  frame  at 

Oil  JC 

k,  to  the  LOS  frame  at  time,  k+1  (Equation  2.33). 


2.38 


2.39 


2.40 


2.41 


2.42 


time 

2.43 
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Note  that  this  model  has  the  position  vector  in  spherical  polar 
coordinates  and  the  velocity  and  acceleration  vectors  in  cartesian 
coordinates.  There  is  a linearization  required  in  Equation  2.35,  but 
since  M is  diagonal,  only  three  components  need  to  be  approximated. 

The  stepping  coordinate  transformation  may  be  performed  analytically, 
but  experience  gathered  so  far  suggests  that  the  approximation  shown 
in  Equation  2.33  is  quite  adequate.  However,  no  linearization  is 
required  to  step  the  coordinates. 

The  above  formulation  of  a linearized  model  is  only  one  of  a number 
of  possibilities.  As  an  alternative  the  entire  target  model  may  be 
expressed  in  spherical  polar  coordinates.  In  such  a formulation  the 
target  model  equations  are  still  nonlinear,  i.e.  quadratic  terms  in 
angular  rates  , and  the  target  noise  must  be  subjected  to  another 
transformation  to  convert  it  to  spherical  polar  coordinates. 

As  a third  possibility,  if  the  entire  target  model  is  expressed 
in  Cartesian  coordinates,  then  the  observation  model  is  nonlinear.  The 
perceived  observations  are  still  , of  course,  in  polar  coordinates.  The 
observations  cannot  be  linearized  by  approximations  of  the  same  type 
already  suggested  in  the  proposed  target  model.  The  first  term  of  the 
observation  model*  i.e.,  Hx  when  linearized,  is  inherently  nonlinear  in 
the  sense  that  a cartesian  position  vector  does  not  factor  out.  The 
linearization  will  require  a Taylor  series  approximation  of  the  Hx^  term 
for  which  the  choice  of  the  origin  of  the  expansion  is  crucial  to  ob- 
taining a useable  value  of  H.  The  matrix,  H,  plays  an  important  role 
in  the  estimation  algorithms  which  follow.  Thus  a Cartesian  position 
vector  is  to  be  avoided  if  at  all  possible. 

It  would  appear  that  the  simplest  compromise  between  target  noise 
transformations  and  polar  position  vectors  would  be  to  leave  the 
positions  vectors  (possibly  the  velocities  also)  in  spherical  polar 
coordinate  and  represent  the  accelerations  in  Cartesian  coordinates. 

The  resulting  hybrid  equations  of  motion  were  summarized  earlier  in 
this  section. 
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In  order  to  explicitly  show  the  forms  of  the  various  alternative 
linearizations,  the  position,  velocity,  and  acceleration  vectors  will 
be  combined  into  a single  state  vector,  X,  which  in  the  various 
coordinate  frames  becomes: 


(a)  Spherical  Polar 


X = 


2.44 


-LOS  = 


a 


y 

a 


z 


where:  w * Angular  rate  about  the  Z,..  axis, 

z & LOS 

~ Angular  rate  about  the  Y^g  axis. 
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(b)  Cartesian 


X = 


x 

Y 
v 

y 

a 

y 

z 

V 

z 

a 


z 


2.45 


(c)  Hybrid 


X = 


x 

0 

V 

y 

a 

•y 

v 

v 


z 


a 


2.46 


The  linearized  model  in  each  case  is  of  the  form 

X = A X + B U 2.47 

where  the  parameters  A,  and  for  the  various  coordinates  frames  are: 
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(a)  Spherical  Polar  * 


* This  form  leaves  the  accelerations  in  the  LOS  coordinate  frame  and 
assumes  that  stepping  coordinates  are  employed  for  the  accelerations. 
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Note  the  presense  of  quadratic  terms  in  the  angular  rates 
(b)  Cartesian 


— 

0 

1 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

-a 

1 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

-a 

B = 

0 

0 

0 

0 

1 

0 

0 

1 

0 

0 

£ 

0 

0 

1 

0 

0 

0 

0 

0 

-a 

0 

0 

0 

0 

0 

1 



2.49 


(c)  Hybrid 


“ — 

— — 

0 10 

0 0 0 

0 0 1 0 0 

0 0 0 

0 0 -a 

1 0 0 

1 

0-0 

r 

B = 

0 0 0 

0 0 0 1 0 

0 0 0 

o 

O 

it 

m* 

0 10 

0 * — ^ — 0 

rCos0 

0 0 0 

0 0 0 0 1 

0 0 0 

0 0 -a 

0 0 1 

2.50 
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The  observation  models  also  show  the  influence  of  the  choice  of 
coordinate  frames.  The  observation  models  are  of  the  general  form. 

Y = H X + V 2.51 

where  in  each  case: 


(a)  Spherical  Polar  and  Hybrid 


H = 


1 0 
0 0 
0 0 


0 

0 

0 


0 

1 

0 


0 

0 

0 


0 

0 

0 


0 

0 

1 


0 0 
0 0 
0 0 


2.52 


(c)  Cartesian:  The  observation  model  in  this  case  is  derived  from 

Taylor  series  expansion  of 


x = r cos0  cosy 

y * r sin©  2.53 

z = r cos0  siny 


leading  to  the  form 


Ir  = *r  (0)  + H (X  - X (0))  2.54 

where  (0)  and  X (0)  are  the  origin  of  the  expansion  and  are 
conveniently  chosen  to  be 

A 

X (0)  = (X  ) spherical  polar  position  2.55 

— r - ~~r  k « K-  x 


X 


(0) 


~ — k,k-l 


cartesian  position  2.56 
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Thus  a ficticious  observation  is  formed 

- " k,k-l  + - A,k-1 

but  the  innovation  process  simplifies  to 


H X + V 


I - fir5  k.k-1 


In  this  case  the  H matrix  becomes 


H = 


cos0  cosT  0 0 


sin2©  cosT  0 0 

A ' “ 


-sin  T 


sin©  0 

A A 

sin©  cos©  0 

A 

y 

o o 


_ z 


cos©  sinT 


A A A 

0 -sinz©  sinT 
* 


•sinT  cosT 


2.57 


2.58 


0 0 
0 0 

0 0 
2.59 


This  illustrates  the  extent  to  which  approximations  must  be  employed  to 
linearize  the  observation  model. 

In  this  case,  the  raw  observations  could  also  be  converted  to 
Cartesian  coordinates  by  Equation  2.53.  Using  the  original  observation 
equation,  this  transformation  may  be  represented  as  Equation  2.61. 

Y = X + V (Position  observations  in  Spherical  2.60 

-r  — r — r r 

Polar  Coordinates) 


Y_  = f(Yr)  = £ (Xr  + Vr)  (Position  observations  converted  2.61 

to  Cartesian  Coordinates  by  f (Y  ).) 

— r 

Using  a Taylor  series  approximation  to  the  right  hand  side. 


Y = f (X  ) + 3f 

" " r TT 


— r 


V + 
— r 


2.62 


X 

— r 
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or,  using  only  the  first  two  terms  as  an  approximation 


I - * * IrE  Ir 


2.63 


where 


IrE  = 


cosO  cos? 

A 

sin© 

/V  A 

cos©  sin? 


A A ✓V  A A 

-rsin0  cos?  -r  cos0  sin? 

/v  A 

r cos0  0 

A A A A A 

-r  sin0  sin?  r cos©  cos? 


2.64 


This  transformation  appears  most  prominently  in  the  representation  of 
the  observation  noise  statistics. 

T 

Rg  = T^g  Rr  T^g  : Covariance  of  the  observation  noise  2.65 

in  Cartesian  Coordinates 

The  innovation  process  would  be 


where  H is  of  the  form 


f (Y  ) - H X 


— — r 


— -k,k-l 


2.66 


2.67 


It  has  been  shown  in  this  discussion  that  the  preferred  coordinate 
systems  are 

1.  Cartesian  Coordinates  for  the  Target  Model. 

2.  Spherical  Polar  Coordinates  for  the  Observation  Model. 

The  advantages  of  the  hybrid  coordinate  system  should  now  be  evident. 
The  best  of  both  possible  approaches  is  achieved  by  representing  the 
observed  components  of  the  target  state  in  spherical  polar  coordinates. 
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and  the  remaining  components  in  Cartesian  coordinates.  The 
linearizations  in  the  hybrid  approach  are  as  few  and  as  straightforward 
as  one  could  hope  to  achieve  in  this  paradoxical  situation. 

3.0  Estimation  Algorithms 

3.1  The  Kalman  Estimator 

Most  of  the  latest  generation  of  fire  control  systems 

C4-) 

utilize  an  estimation  algorithm  proposed  by  Kalman  and  discussed  in 
numerous  texts  (1)  (2)  (3).  The  Kalman  algorithm,  also  known  as  the 
Kalman  filter,  provides  an  extension  of  least  squares  estimation  tech- 
niques to  linear  dynamical  systems.  Given  a discrete  dynamical  system 
of  the  form; 

= 4*  + \ (Equation  1.6)  3.1 

together  with  an  observation  model, 

Xfc  = ilfc  + Xfc  (Equation  1.7)  3.2 

and  noise  models 


9*-E 

(Equation  1.8) 

3.3 

(Equation  1.9) 

3.4 

The  purpose  of  the  estimation  algorithm  is  to  obtain  estimates,  X^, 
of  the  state  which  are  as  close  as  possible  to  the  true  state, 

X^,  and  which  are  unbiased  in  the  sense  that, 

E (XjP  = E (X^)  3.5 

The  measure  of  closeness  which  is  utilized  is  the  norm  of 

pk  =«**  - **>  i 3-6 
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This  matrix  represents  the  variance  of  the  estimation  errors. 

The  Kalman  algorithm  suggests  the  computation  of  a predicted 

A 

estimate,  (The  estimate  based  upon  k-1  observations)  and  a 

K , k-l  a 

corrected  estimate,  ^ (The  estimate  based  upon  k observation). 
The  associated  error  variances  are  written  as 


P.  , . and  P, 
-k,k-l  -k,k 

The  predictor  phase  of  the  estimation  is 


^k,k-l  = ^k-l,k-l 


3.7 


^k,k-l  * ^k-l,k-l  - + AAi, 


3.8 


and  the  corrected  estimate  is 


*k.k  ■ 4, k-i * k ttk  - 4 3-9 

Bk,k  = ^k,k-l  ■ Bk,k-1  Bk  ^5k  + Bk  £k,k-l  Bk  ) i^Bk.k-l  3.10 

Bk=  Bk,k-i-?  ®k  * HA.k-iBkV1 


where  is  often  referred  to  as  the  Kalman  gain. 

The  equations  3.7  through  3.10  define  a recursive  computation  of  a 
sequence  of  estimates  based  upon  a sequence  of  observations,  Y^>  which 
arrive  one  at  a time.  The  variances  of  the  estimation  errors  are  com- 
puted routinely  along  with  the  estimates.  It  should  be  noted  that 
Equations  3.8,  3.9,  and  3.10  represent  an  independent  sequence  of 
computations.  In  particular , for  a pre-specified  and  R^,  the 
Kalman  gain  can  be  computed  independently  of  the  observations,  Y^,. 


24 


In  situations  where  the  theoretical  model  is  known  to  only  partially 
represent  the  true  target  behavior,  i.e.  during  maneuvers  , the  physical 
significance  of  a(Equation  1.3),  and  may  be  unattainable.  A more 
algorithmic  view  would  lead  one  to  choose  a and  2^  in  such  a way  that 
the  estimates  have  desirable  properties  in  terms  of  frequency  content 
or  predicting  power. 

3.2  Prediction 


In  its  purest  form  the  process  of  predicting  the  future  position 
of  the  target  involves  integrating  the  equations  of  motion  over  the 
time-of-flight  of  the  projectile.  However,  rather  than  resort  to  num- 
erical integration,  the  same  linearizations  and  discretizations  employed 
in  the  Kalman  estimator  mr.y  be  employed  to  give  a predictor  of  the  form. 

/v 

X (t+tf)  = # (t,tf)  X (t)  3.11 

where  t^  is  the  projectile's  time  of  flight. 

Since  observations  are  not  involved  in  this  process,  it  is  most 
convenient  and  accurate  to  perform  the  predictions  in  Cartesian 
coordinates.  Furthermore,  if  only  the  positions  are  to  be  predicted, 
only  the  inner  product  of  the  top  view  of  $>  and  X needs  to  be 
computed. 

3.3  Biased  Estimation 


It  has  been  shown  that  biased  estimates  have  some  highly  desir- 
able properties  in  both  least  squares  and  dynamical  problems.  A 
biased  estimation  scheme  based  upon  the  work  of  Hoerl ^ ^ and  Chang ^ 
is  outlined  here  as  a suggested  refinement  to  the  Kalman  filter. 


The  biased  estimation  algorithm  requires  obtaining  the  unbiased 

A A 

estimate,  X^  ^ and  ^ according  to  equations  3.6  and  3.8.  The 
"corrected  estimate",  X,  , is  further  refined  by 


X*  . - Z X.  , ; 
-k,k k,k 


3.12 
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where 


i ■ Op  - KEk,k“-  (K£  \k  a * V"1  aT)  3-13 

A 

is  a biased  estimate 

“k,k 

K is  a positive  scalar; 

a is  a pxq  matrix  of  rank,  q,  and  p is  the  dimension  of  X^. 

Using  the  following  definitions  of  variances 


4,k 

se  «*kk  - 

(4,k  - > 

3.14 

5,k 

-E  «i!k  - 4> 

A rp 

^ - *k>  > 

3.15 

=E 

«i,k  - E <4> 

) C4>k  - Ety,1') 

3.16 

111 

m 

«siu  - E 

) 4*>k  - ecx,))7) 

3.17 

it  can  be  shown  that  the  biased  estimates  have  the  properties 


^k,k  - ^k,k 

S.kiSk.k 


and  further  that  for  small  K 


J>*  . - P,  . - 0 (K  ) 
-k,k  -k,k  - 1 


k - <4*  -4“  > 


3.18 

3.19 

3.20 

3.21 


This  indicates  that  the  loss  of  "optimality"  in  the  Kalman  sense  is 
small  while  the  shift  of  the  estimate  toward  the  expectation  of  the 
true  state  may  be  significant.  This  should  have  a smoothing  effect 
upon  the  estimates,  and  thus  make  the  estimates  more  suitable  for 
prediction. 

The  biased  estimate  (Equation  3.12)  involves  a matrix,  Z, 
which  contains  two  parameters,  K and  o.  These  parameters  are  subject 
to  choice  on  the  basis  of  computational  convenience.  One  possibility 
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is  to  choose  o such  that 


3.22 


-P 


then 


3.23 


Using  this  approximation,  the  biased  estimate  becomes 


- — k,k 


3.24 


This  form  has  the  advantage  of  placing  the  greatest  bias  upon  those 
components  of  estimate  which  have  the  largest  variances.  The  compo- 
nents which  are  least  certain  will  be  shifted  the  most. 

4.  Trajectory  Algorithms 

4.1  Deterministic  Trajectories 

The  target  modeling  techniques  discussed  in  the  previous  sections 
will  be  extended  to  provide  descriptions  of  actual  tactical  trajectories. 
These  trajectories  are  invaluable  to  the  simulation  of  a fire  control 
system,  and  to  the  design  of  the  essential  estimation  and  prediction 
algorithms. 

The  simplest  trajectory  segment  to  simulate  is  the  straight  line. 
The  model  requires  a fixed  velocity;  thus  a state  transition  of  the 
form. 


4.1 
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where  all  components  are  in  Cartesian  coordinates. 


1 At 

0 1 


0 


0 


£= 


o 


1 At 

0 1 


0 


4.2 


0 


0 


1 At 

0 1 


X 


v 

X 

Y 

v 

y 

z 


4.3 


Given  an  initial  position  and  velocity,  X , this  model,  (Equation  4.1), 
can  be  used  to  propagate  the  position  forward  in  time  along  a 
straight  line.  Each  step  requires  a matrix  by  vector  multiplication. 


In  the  case  of  circular  motion,  i.e.  constant  magnitude  of  accel- 
eration , a similar  model  is  possible. 

4.4 


h+1 


c c 

= A X 
— k 


c 

where  X^  ^ is  same  as  Equation  4.3  except  that  the  position  components 
are  represented  with  respect  to  center  of  curvature  of  circle.  This 
new  position  vector  is  related  to  the  old  one  by 


x_  = x.  + xc 

— E — L — 


(position  only) 


4.5 


where  X^  is  the  position  of  the  center  of  curvature,  and  Xg  is  the 
position  in  the  inertial  or  earth  frame  of  reference.  The  state 
transition  matrix,  is  now 
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cos  w At  — sinwAt 

to 

-wsinwAt  cos  u>At 


4 = 


0 


0 

cos  wAt 

— sinajAt 

U) 

0 

-wsinwAt 

cos  uAt 

0 

coswAt  — 
0) 

sincoAt 

0 

1 

H* 

ct 

coswAt 

4.6 

Where  to  is  the  angular  rate  of  circular  motion.  The  parameters, to, 
and  X^,  must  be  specified  to  determine  a circular  trajectory.  If  the 
circular  trajectory  is  orly  one  segment  of  a continuous  smooth 
trajectory,  then  the  initial  position  and  velocity  are  present.  The 
radius  of  curvature  is  also  constrained  to  be  perpendicular  to  the 
velocity  vector.  All  of  these  constraints  leave  only  three  degrees  of 
freedom  in  specifying  a circular  trajectory: 

1. )  co  - The  angular  rate. 

2. )  The  magnitude  of  the  radius  of  curvature. 

3. )  The  orientation  of  the  radius  of  curvature  (one  angle) 


In  a velocity  vector  oriented  coordinate  system^  i.e.  X axis  is 
aligned  with  the  velocity  vector  , the  position  vector  with  respect  to 
the  center  of  curvature  is 


0 

COS0 

c 

sin0 

c 


4.7 


where  0£  is  the  orientation  of  the  plane  of  motion  with  respect  to 
the  vertical  plane,  and  rC  is  the  magnitude  of  the  radius  of  curvature. 
The  position  of  the  center  of  curvature  is  therefore 


k - - JvB  LXv> 


4.8 
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and  the  initial  position  vector  with  respect  to  the  center  of  curvature 
is 


X-  " IvE  *v 


Thus,  for  circular  motion,  the  positions  and  velocities  may  be  propa- 
gated forward  in  time  by  the  following  sequence  of  computations: 


1.  Initialization 

(a)  Given  (X^  E and  (V^)  E with  respect  to  a convenient 
inertial  coordinate  system. 

(b)  Specify  u),  r , 0 . . 

(c)  Compute  and  hold  X,  (Equation  4.7  and  4.8) 

(d)  Initialize,  X ; (Equation  4.4) 

c 

2.  Compute  a new  state,  X.  , (Equation  4.4) 

3.  Compute  the  state  in  the  inertial  coordinate  system  (Equation 
4.5) 

4.  If  trajectory  continues,  then  go  to  step  2. 

5.  Result  of  last  step  3 is  the  current  position  and  velocity. 


Trajectories  which  are  segments  of  either  straight  lines  or  circles 
are  easily  simulated  by  the  procedure  outlined  here.  Invariance  of  the 
state  vector  between  segments  will  assure  continuous,  smooth  trajectories. 


4.2  Stochastic  Trajectories. 

The  equations  of  the  previous  section  may  be  extended  to  allow  random 
motion  to  be  superimposed  upon  the  straight  line  and  circular  motion. 

In  a single  component  , e.g.  the  X-component  , the  equations  of  motion 
are: 

(a)  Straight  line  trajectory 

x = v 4.10 

x 

v = a ; a is  a random  forcing  function.  4.11 

X XX 

(b)  Circular  trajectory 

x = v 4.12 

x 

v = -X  + a ; a is  a random  forcing  function  4.13 

X XX 
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In  the  case  of  the  straight  line,  the  equations  of  motion  are  in  the 
same  form  as  Equations  1.1  and  1.2.  The  straight  line  equations  lead 
to  an  A and  J)  matrix  identical  to  equation  2.46.  In  the  case  of 
circular  motion  the  A matrix  becomes 


0 


0 


4.14 


0 


0 1 0 

0 -10  1 

0 0 -a 


A discrete  form  of  the  equations  of  motion  may  be  obtained  by  integration 
over  a step  At.  The  resulting  <£.  and  B,  are 


*k 


In  ° » 

5 —22  ^ 

£ 4 I33 


where 


*ii 


coswAt 


inwAt  <J) 


-wsinwAt  cosaiAt 
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In  the  limit  as  co  goes  to  zero,  these  equations  become  the  straight 
line  discrete  equations  of  motion.  The  equations  of  motion  obtained 
from  Equations  4.15  and  4.18  may  be  used  to  simulate  circular  motion 
with  a random  perturbation.  Thus,  both  the  deterministic  and  stochastic 
aspects  of  the  motion  are  modeled. 
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5 . Future  Work 


An  Approach  to  Closed-Loop  Systems 

Considerable  interest  has  been  shown  recently  in  closed- loop  fire 
control  systems  which  use  observations  of  bullet  position  to  correct 
for  modeling  errors,  drift,  misalignment  of  the  gun,  etc.  The  inherent 
stability  and  robustness  of  a feedback  configuration  may  lead  to  signi- 
ficant improvement  in  performance  of  the  overall  system. 

Since  the  added  complexity  of  a closed-loop  system  has  been  diffi- 
cult to  justify  a priori,  the  implementations  have  taken  the  configu- 
ration of  an  "add-on"  component.  The  target  state  estimation  and 
prediction  phases  of  fire  control  are  operated  independently  of  any 
possible  closed-loop  configuration.  As  the  justification  for  closed- 
loop  fire  control  becomes  evident,  an  overall  systems  analysis  will  be 
needed  to  properly  integrate  the  closed-loop  with  the  rest  of  the 
system.  The  analyses  discussed  in  this  report  should  be  extended  to 
establish  the  essential  mathematical  structure  and  computational  burden 
of  such  systems. 
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SOFTWARE  SUPPORT 


In  the  process  of  developing  the  analytic  capability  to  simulate 
and  evaluate  fire  control  systems,  a so-called  "poly-algorithm"  was 
implemented.  This  is  the  software  support  necessary  to  set  up  and  run 
the  important  algorithms  which  arise  in  modern  control  theory.  The 
design  of  the  software  was  based  upon  the  premises  that: 

(1)  The  algorithms  each  go  through  cyclic  computations,  and  there 
is  a point  in  each  cycle  where  input  data  may  be  permitted  to  influence 
a computation. 

(2)  The  terminology  and  notation  of  modem  control  theory  have 
stabilized  and  established  the  possibility  of  a finite  data  base  to 
support  the  algorithms.  The  size  and  entries  in  the  required  symbol 
table  may  be  predetermined  without  unduly  constraining  the  user's 
expressive  power. 

The  objective  of  implementing  this  poly-algorithm  was  to  provide 
a simple  data  handling  discipline  which  would  permit  the  user  to  select 
algorithms  which  would  be  run  singularly  or  in  tandem.  Thus,  in  the 
application  discussed  in  the  body  of  this  report,  the  trajectory 
algorithm  would  be  followed  by  an  estimation  algorithm  which  in  turn 
is  followed  by  a prediction  algorithm. 

The  data  from  one  algorithm  is  used  as  the  parameters  for  the. next 
algorithm.  The  user  "programs"  in  a very  nonprocedural  way  in  specifying 
what  to  do  rather  than  how  to  do  it. 

The  design  of  the  software  was  constrained  by  the  requirement  that 
the  user  be  able  to  escape  to  a familiar  language  whenever  the  poly- 
algorithm is  found  to  be  inadequate.  Thus,  the  entire  system  was 
implemented  in  Fortran.  Since  some  symbolic  and  character  processing 
is  required,  some  nonstandard  features  of  Fortran  are  employed  but  are 
not  permitted  to  diffuse  throughout  the  programs. 

The  data  and  control  structure  of  the  poly- algorithm  are  highly 
modular  in  their  designs.  A hierarchy  of  control  linkages  is  established 
according  to  Figure  A-l . The  Fortran  implementation  imposes  a strictly 
imbedded  subroutine  structure  upon  the  software. 
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In  a typical  session  of  execution  of  one  or  more  algorithms,  the 
MAIN  program  passes  control  to  the  DRIVER.  Data  is  acquired  as  necessary 
to  establish  parameters  for  a computation.  When  the  DRIVER  encounters  a 
call  upon  an  algorithm,  it  returns  control  to  MAIN  with  information  about 
which  algorithm  is  to  be  initiated  (including  EXIT  if  desired) . The 
algorithm  will  initiate  a cycle  of  the  computation  during  which  the 
DRIVER  will  be  called  again.  Further  data  editing  is  possible  while 
the  algorithm  is  interrupted.  The  DRIVER  passes  back  to  the  algorithm 
information  about  whether  to  continue  or  return  to  the  MAIN  program. 

With  control  in  the  MAIN  program,  the  computations  continue  as  though 
it  is  the  beginning  of  the  session. 

The  data  base  established  by  the  poly-algorithm  consists  of  a 
PRIMARY  DATA  BASE  and  a BULK  FILE.  These  form  two  nodes  in  a data  flow 
network  as  shown  in  Figure  A-2.  The  PRIMARY  DATA  BASE  allocates  space 
on  the  basis  of  common  names  of  variables  in  modern  control  theory,  i.e., 
X,  A,  PHI,  U,  V,  etc.  The  sizes  of  the  arrays  are  controlled  by  the  user 
through  length  variables,  i.e.,  LX,  LA,  LPHI,  LU,  LV,  etc.  The  BULK  FILES 
are  not  associated  with  any  particular  variable  names,  but  instead  pro- 
vide storage  for  time  sequences  of  inputs  or  outputs  of  computations. 

Thus,  a time  sequence  of  ranges  may  be  produced  by  the  trajectory 
algorithms  as  the  X vector,  and  these  same  numbers  may  be  retrieved  as 
observations  by  the  Kalman  filter  in  the  Y vector. 
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Figure  A.l  Control  Structure  of  Modern  Control 
Software. 
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Figure  A. 2 Data  Flow  Network  for  Modern 
Control  Software. 
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SAMPLE  FIRE  CONTROL  COMPILATIONS 


As  an  example  of  a fire  control  system  computation,  the  simulation 
of  a target  state  estimator  will  be  discussed  in  detail.  It  will  be 
presumed  that  the  trajectory  algorithm  has  computed  positions  (r,  0, 
and  left  them  on  BULK  FILES  8,  9 and  10  respectively.  The  data  set  up 
for  the  target  state  estimator  would  proceed  in  the  following  stages. 

a.  Specify  sizes  of  all  the  vectors  and  matrices. 

b.  Generate  PHI,  B,  Q,  R and  H,  DEL  (Timestep) . 

c.  Initialize  X,  P,  and  TIME. 

d.  Connect  BULK  FILES  8,  9 and  10  to  the  observations,  Y. 

A 

e.  Connect  TINE  and  estimated  state,  X,  to  BULK  FILES  in  order  to 
save  them  for  prediction. 

Having  set  up  the  data  and  established  the  data  flow  between  the  PRIMARY 
DATA  BASE  and  the  BULK  FILES,  the  estimation  algorithm  is  run  through 
as  many  cycles  as  desired.  During  each  cycle,  data  may  be  displayed  as 
illustrated  in  Figure  B-l. 

The  data  stored  by  the  trajectory  algorithm  and  the  estimation 
algorithm  form  the  basis  of  a simulation  of  predictor  performance.  The 
estimated  states  are  retrieved,  extrapolated  ahead  in  time,  and  compared 
with  the  trajectory.  The  resulting  prediction  errors  form  the  basis  for 
evaluation  of  the  fire  control  system. 

A parametric  study  of  the  performance  of  fire  control  systems  is  now 
in  preparation  and  will  appear  in  a forthcoming  progress  report. 
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Figure  B-l  Example  of  Kalman  Target  State  Estimator  Output 
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